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introduction 


Chapter 1. 


Problem Descriptrion 


This diesis deals with the time-optimal control of a tendon arm system. The tendon arm system 
consists of a rigid link attached to a base plate through a three degree-of-freedom joint thus affording die 
arm rotational freedom in three axes Movement of the arm is made possible by four tendons: one end 
of each tendon is attached to the top of die arm and the other end is wound on a motor shaft located 
under die base plate. The design of the tendon attachments is such that dirough the interaction of die 
four motors and tendons, and by controlling die current input (or torque output) of die motors, control of 
the movement of the arm in dirce axes is possible. Section 2.1 contains a more detailed description of the 
tendon anti system, and figure 2-1 shows a schematic diagram of it. The tendon arm system is designed by 
John Hollcrbach and Danny Hillis of the M.I.T. Artificial Intelligence Laboratory. 

We are interested in designing a controller to move die arm from an initial position to any specified 
final position. Time-optimal control is chosen because 

1. it achieves the desired motion in minimum dme — this is desirable because die faster it can move, the 

more motion tasks per unit time could be completed this way, and 

2. it requires few words of computer memory to represent the optimal solution — traditionally, time- 

optimal solution is associated with bang-bang control, hence the optimal solution is completely 
specified by the switching times. 

These are the motivations for choosing time-optimal control, namely, it yields a rapid-moving system 
which is implementable. 

The second point mentioned in the last paragraph is only valid if the problem is nonsingular. In 
the presence of singularity, the ume-optimal solution need not be bang-bang. Our problem is, in fact, 
singular, but die form of the singular arcs is such that die control signals can be approximated very closely 
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by straight line segments, hence the storage requirements for such a control is quite low also (about 5 
integer words per trajectory). 

Since our system equations arc highly nonlinear and complicated, it is not possible to express the 
optimal solution in feedback form. Thus, in addition to this open-loop control, some sort of closed-loop 
control law is required to correct for any disturbances. I he overall control scheme will consist of two 
phases : an initial phase during which open-loop time-optimal control is app ied, and a second phase 
which is feedback regulation at the final position. 

Although time-optimal control has been applied to manipulators (Kahn[lj), it does not shed much 
light on our problem because the tendon arm is different from conventional manipulator design. The only 
reference that is available on tendon arm dynamics is Riemenschneidci et al [2] but the paper deals with a 
one degree-of-freedom arm which is much simpler than the three degree-of- freedom arm studied herein. 

1.2 Thesis Outline 

This thesis is organized into seven Chapters: 

Chapter 1 provides an introduction to the problem under study. 

Chapter 2 describes the physical tendon arm system and develops a mathematical model describing the. 
system. A simplified reduced-order model is also obtained, and the responses of the two are com 

pared. 

Chapter 3 first states the time-optimal control problem and presents necessary conditions for the optimal 
solution from Pontryagin’s Minimum Principle. These are then applied to the reduced-order model 

of the tendon arm system. 

Chapter 4 presents the conjugate gradient method and describes an iterative procedure for solving our 
time-optimal problem. Approximation for the time-optimal solution is also proposed. 

Chapter 5 motivates tire need for a closed-loop feedback control law at the final position, and presents the 
linear regulator approach for designing the feedback law. 




Chapter 6 describes the implementation of the overall control scheme. 

Chapter 7 is a summary of the results of tine thesis and describes areas of further work. 



Chapter 2. Modeling of the Tendon Arm System 

In order to study and develop a control strategy for the tendon arm system, we must have a mathe¬ 
matical model of it. In this Chapter, the physical system is first described, equations describing the system 
dynamics are then developed, and a reduced-order model is obtained by ignoring the third degree-of- 

frccdom of the arm. 


2.1 A Description of the Tendon Arm System 

The schematic diagram of the tendon arm system is shown in figure 2-1. It is a cylindrical rod, known 
as the ann, attached at one end to a ease plate via a three degree-of-frecdom "joint". Figure 2-2 shows 
the "joint" in greater detail. The outer rectangular block, together with the inner member, can be rotated 
about the Y — Y axis. The inner member can be independently rotated about the X — X axis. The 
cylindrical part of the inner member can be rotated about the Z — Z axis, i.e. the longitudinal axis of the 
cylinder. Potentiometers are mounted as shown in the diagram to measure the three angles of rotation. 
This construction of the "joint" lends itself to a very natural way of defining the position of the atm 
in terms of the three angles 0, <p, and ip, which are measured directly by the potentiometers, as shown 

in figure 2-3. This coordinate system will be used throughout this thesis to describe the arm. Another 

• $ 

coordinate system, described by the angles a, (3, and ip, is sometimes used. This is shown in figure 2-4. 

At the Upper half of the cylindrical rod, there are points of "insertion" (attachment) for four tendons, 
two at one height, and the other two at another. Each tendon is wrapped around the arm through a certain 
angle before it breaks off from the surface of the arm (see figure 2-5). The other end of the tendon passes 
through a pulley on the base plate and is wrapped round a threaded cylinder mounted on the shaft of a 
motor under the base plate. As the motor rotates, the tendon will be wrapped or unwrapped from the 
motor shaft thereby causing a shortening or lengthening of the tendon between the motor and the arm. 
Through the interaction of the four motors and tendons, the arm can be moved from one position to 
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Figure 2-1. Schematic diagram of the tendon arm system 


another. 

2.2 Equations of Motion 

2.2.1 Coordinate Systems and Coordinate Transformation 

We choose as our fixed coordinate system one that has its origin at the "joint" with the x-axis along 























Figure 2-1 A more detailed diagram of the three degree-of-freedom “joint" 

p 3j P4 and the y-axis along P2, Pi. Pi, P2, Pi, and P4 arc tlic points on the base plate through which the 
tendons pass (refer to figure 2 - 5 ). 

In computing the dynamics of the arm, we refer all quantities to a moving coordinate system which 
is fixed to the arm and with the three axes coinciding with those of the fixed coordinate system when 
0 _ 0 = 1 /, = Q. These three axes are the principal axes of the arm. 








Figure 2*3. Angles defining the position of the Figure 2-4. Another set of angles that defines 
arm the position of the arm 


If P denotes the coordinates of a point in the fixed coordinate system, to refer it to die moving 
coordinate system, we need to perform the following transformations: 

1 . a rotation through an angle <p about the y-axis, and 

2 . a rotation through an angle 0 about the new z-axis, and 

3. a rotation through an angle xp about the new 2 -axis. 


t.e. 


P' = S z (xp) S x (0) Sy(<f>) P 


( 2 . 1 ) 


where F denotes the coordinates of die point referred to the moving (primed) coordinate system, and 
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( 2 . 2 ) 


P' — W{9,<p, xp)P (2.3) 






W(9,4>, rp) = 


cos (p cos ip + s ^ n 0 sin <p sin ip 
— cos <p sin ip + sin 9 sin (p cos ip 
cos 9 sin <p 


cos 9 sin ip 
cos 0 cos ip 
— sin# 
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(2.4) 


2.2.2 Some Geometric Calculations 

Referring to figure 2-6 which shows some parameters of the arm, 
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Using equation (2.3), 


(2.5) 



a cos 9 sin ip 
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( 2 . 6 ) 


From now onwards, we will refer all quantities to the moving coordinate system. 

Let Qi be the point at which tendon i is attached to the arm, and ft, be the point at which tendon i leaves 
the surface of the arm. Then in order to calculate the directions in which the tendons pull on the arm, we 
need the coordinates of the 71,’s. 








Figure 2-6. Schematic diagram showing some parameters of the arm. 

Coordinates of R\ andRi 
Let ( x \, yt, Z \) denote the coordinates of R\ with respect to tire primed coordinate system. 
From figure 2-7(a) and equation (2.6), 






Figure 2-7. (a) Schematic of the arm looking down the z'-axis showing only tendon 1. (b) 

Unwrapping tendon 1 onto a plane. 


uo — tan 


— \ 



( 

V,acos0 ) 


a cos 0 sin ip 
a cos 9 cos tp 

P 


) 


= t/> 


where p is the radius of the cylindrical arm. 


x\ = sin(7r — X — u>) = psin(w 4* 
y\ — —p cos(tt — X — O)) = pcos(u/ -j- M 


Referring to figure 2-7(b), 
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implies 


M\R\ _ Q\M\ 

R\N\ " NiPi 


z\ = — asin 0 + 


b “j~ (x sin 0 


1 + (t ~ w — X)/ tan X 


L\ = R\Pi 


h = Q\Pi 


[z{ -)- a sin 0 ) 2 -j- p 2 tan 2 X 


J 


Q <7T <■ 

(6 + a sin ^) 2 p 2 ( cu — X -f- tan X ) J 


( 2 . 11 ) 

( 2 . 12 ) 

(2.13) 


Similarly, the coordinates ofR 2 arc given by, 
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(2.14) 

(2.15) 

(2.16) 

(2. IT) 

(2.18) 


Coordinates of R 3 andR,\ 

Let (x 3 , 1 / 3 , 23 ) be the coordinates ofi? 3 in the primed coordinates. 
From figure 2-8(a) and equation(2.6), 




tan 1 
tan -1 


— cos (j) sin xp -}- sin 0 sin <j> cos xp 
• cos <p cos xp -f- sin 0 sin <j> sin xp 
tan xp -f- tan <f> sin 0 


) 


( _ 
J 


-j- tan xp tan (frslhO 


) 


(2.19) 


Define 


y, 1 i nwm iii j i jj : ; 

(2.20) 


tan ff — tan <j> sin 0 




Figure 2-8. (a) Schematic of the ami looking down the z'-axis showing only tendon 3. (b) 

Unwrapping tendon 3 onto a plane. 


Then from equations (2.19) and (2.20), 
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Referring to figure 2-8(b), 
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implies 


M,R, = M/h 
R 3 N 3 N 3 P 3 

t -j- ssirupcosO 

23 = r+(3f -u/-V)/taV 

L3 = R 3 P 3 — [z-j + s sin <f> cos 6 ) 2 + p 2 tan 2 X' 

M 

J 3 = QjPj = (t -f- ■ ; sin <?!> cos#) 2 + p 2 (^- — u;' — X' + tar. X') 2 


Similarly, for J? 4 , 


(2.25) 

(2.26) 
(2.27) 



X4 = p cos(u/ -f- X') 
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t — s sin cos# 

za — s sin 6 cos 6 -f- -——r=—--- tttt; — r; 
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(2.28) 

(2.29) 

(2.30) 

(2.31) 

(2.32) 


Coordinates of the center of gravity 

Let G be the center of gravity of the arm (see figure 2-6), and let GD be the unit vector along the 
direction of the gravitation field which will be assumed to be vertically down. 

Expressed in the primed coordinate system, 

O' 

G — 0 (2.33) 

d 

sin (f) cos ip — sin 0 cos <p sin t/> 

— sin <p sin ip — sin 0 cos <p cos t p 
— cos 0 cos <p 

2.2.3 Resultant Torque exerted by the four Tendons about the point of rotation O 
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LetFj, i — 1,..4, be the tension in tendon i, the direction ofF; will be in the direction ofFjPj. 
Resultant torque acting on the arm about O 


ORi X Fi + OR 2 X F 2 + dill X F 3 + OR 4 X F 4 + OG xrrig 

m-\ ok ' x oh x fl2>2 + wk\ oh3X 


X R 4 P 4 + mgOG X GD 


' | RaPa\ ' 

m + jt 2 + m 


(2.35) 


where 
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(2.36) 


(2.37) 


(iT ^-)p acos ^^ n ^ + + ^Jps[sin0sin0cos(X' p!) — cos<£sin(X' + p')] (2.38) 




Note: The expressions in equations (2.36M2.38) are derived based on the geometry of the arm as 
described in section 2.2.2, which assumes that all the tendons are wrapped properly on the arm. In the 
course of moving from one position to another, one pair of the tendons might be completely unwrapped, 
hence the expressions developed above will not be valid. 

Referring to the notations used in section 2.2.2: 

if w + X > 37r/4, then tendons 1 and 2 have completely unwrapped, and 
if u/ -f X' > 37r/4, then tendons 3 and 4 have completely unwrapped. 






Appendix A develops die corresponding expressions for equations (2.36)-(2.38) in the event of either pair 
of tendons is unwrapped. These expressions are only approximations as the tendon insertion is not ideal. 

2.2.4 Arm and Motor Dynamics 

Euler’s dynamical equations for the rotation of a rigid body about a point O are given by, 

O'. 

Ji - (J2 - ^)n 2 n 3 = n 

at 

- [h - /i)n 3 n, = t 2 (2-39) 

- ( J { - J 2 )n l n 2 = t 3 

at 

where the subscripts 1, 2, 3 refer to the three principal axes of the rigid body, fij, Ji are the angular 
velocity and the moment of inertia, respectively, of the.arm along the i-axis, and is the external 

applied torque on the body. 

By making the identification of the 2 /-, y'-, 2 / -axes of the arm primed coordinate system with the 
1 - 2 -, 3-axcs of the above, we can apply equation (2.39) to the tendon arm system, with the simplifying 

assumption that 

J { = J 2 = J, (2.40) 

♦ 

This assumption is valid because the contribution of the moment of inertia of the lower rectangular block 
about point O, which is asymmetrical about the s'-axis, is negligible compared to that of the cylindrical 

rod, which is symmetrical. 

Expressing die ft j’s in terms of the diree angles 0, <p and ip, we obtain, 



ftl 


m 9 » ** 

9 cos t p <f> cos 0 sin tft 


ft = 

fi 2 
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• • 

—0 sin ip <p cos 0 cos ip 

(2.41) 


n 3 

m — 


— <p sin 0 -f- ip 



7,. T 2 , Tj arc given by equations (2.36H2.38). The tensions F U F 2 ,F 3 ,F 4 in the tendons are related 
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to the input currents to the motors, I\, h . h, h, through the motor dynamics 

Jmii + B mll + F,r = KU i = 1,.... 4 (2.42) 

where 

is the angular velocity of the motor shaft, 

J m is the moment of inertia of tire motor shaft, 

B m is the velocity dependent friction coefficient, 
r is the radius of the cylinder mounted on the motor shaft, and 
K is the torque constant of the motor. 

Because of the constraint that the tendons must be taut at all time, and the assumption that the 
tendons are inelastic, the angular rotation of each motor is related to that of the arm. 

Specifically, 

H* = k> — k{8, <P, VO (2.43) 


where f t ( 0 , <f>, VO is the length of tendon i (from point Q l to point Pi) when the arm is at the position 
defined by 0, <p, ip, and fo = Z,( 0 , 0 , 0 ), which implies that 7 ,• = 0 when 6 — <p = ip — 0 . 

By differentiating equation (2.43) with respect to time once, we obtain 




<9f i • Ql i : 
dtp dtp 


(2.44) 


By differentiating once more. 


H. 


Qli-i . Qli", . Qli ", , 1 n , ,;.2 




e 1 -f 


dtp 


2 P+TJk'l’' 


dip 2 


+ + 2^7 H + 2 ^,# 


QOdtp 


dtpdxp 


QipdQ 


(2.45) 


By substituting equations (2.44M245) into equation (2.42), we can obtain expressions for the F/s in 
terms of tire 7 t ’s and the tliree angles 0 , <p, and ip. By substituting these into equations (2.36H2.39), a set 
of differential equations describing the dynamics of the tendon arm system is obtained. 






By defining, 

-> 


x = [6 <j> i p 0 <f $ T ( 2 -46) 

u = [ I\ h h h] T ( 2 - 47 ) 

and rearranging terms, we obtain the equations of motion of the system in the form, 

x(t) = (2-48) 

where 

Fo(x) isa6-vcctor, and 
Bo(x) is a 6 X 4 matrix. 

The full detail of equation (2.48) is given in Appendix B. 


2.3 Reduced-Order Model 

The equations of motion obtained in the previous section is too complicated to be useful in the 
design of a controller. Much of the complications arises from the geometry of the tendon arm system. 

A simplified fourth order model is obtained by ignoring the tendon wrapping about the arm, thereby 
reducing the three degree-of- freedom arm to a two degree-of-freedom one. This is achieved by equating p 
to zero (recall that p is the radius of the cylindrical arm). 

% •€• i 

p = 0 (2.49) 

This, in effect, is to ignore the twisting movement, 0, of the arm. 

Equations (2.39) become: 

j(0-\-<j> 2 sin0cos0) = — Y^abcoB0 — (j~ — ^Jst sin 0 sin <f> + mgd sin 0 cos 0 (2.50) 

jQ>cos0 — 200sin 0) = — ^Jst cos <f> + mgd sin<p (2.51) 




where 


ij = [a 2 + 6 2 + 2a£>sin0]^ 

1 2 — [a 2 -j - b 2 — 2 ab sin Q\ i 

1 3 — [s 2 + < 2 + 2 st sin <f> cos 0] i 

1 4 — [s 2 -|- f 2 — 2s£ sin <j> cos 0] ^ 


(2.52) 


From equations (2.42)—(2.45), 









(2.53) 


For i — 1, 2, since li is a function of0 only, 






(2.54) 



Substituting equations (2.53H2.54) into (2.50)-(2.51), and rearranging terms, 
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By defining, 
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Equations (2.55)-{2.56) can be written as; 
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Define 

x = [0 <p 6 <fi] T 


the reduced-order model can be written as: 

x(t) — F(i(t)) + 5(x(t))u (2.60) 


where 


F(x(t)) 


X3 (0 

X 4 {t) 

h{x{t)) 


B(x(t)) 


0 


0 


6 4 (a:i(t), a:2(0) 


a 4-vector 


(2.61) 


a 4 X 4 matrix 


(2.82) 


Note: It can be easily shown from equation (2.58) and several simple substitutions that the determinant 

l- 

| 

of N is always greater than zero for all 6 , <j> between (but not including) —7r/2 and +ir/2. Hence N~ 


always exists. 


2.4 Comparing the Responses of the Full and Reduced-order Models 


To investigate the effect of representing a sixth-order system by a fourth-order model, a step of mag¬ 
nitude four is applied to both J 2 and I 4 of the full (sixth) and reduced (fourth) order models developed in 

sections 2.2 and 2.3 respectively. 

The responses of the two models are shown in figure 2-9 and tabulated in Table 2-1. (The values of 
the parameters used is given in Appendix G). 
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It can be seen that the difference between the two is small except for the fact that the reduced order 
system cannot mode! the angle ip. 


Table z -1 (a) Response of Ihe Full Onder Model due to step inputs on I* and I4. 
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Table 2-1 (t>) Response of ihe RedOced order bode I 

due to Step Inputs on Iz and 1 4 
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Chapter 3. 


The Time-Optimal Control Problem 

As mentioned in Chapter 1, we would like to devise a control scheme to bring the arm from its initial 
position to any specified final position as fast as possible, i.e., given any desired position x f , we would like 
to find the control u(t) which drives a(f)" — x f to zero in minimum time, where x(t) is the actual position 

of the arm at time t. 

In this Chapter, we will first fo-mally state die time-optimal control problem as applicable in our 
case, and Pontryagin’s Minimum Principle will then be used to derive necessary conditions for the time- 
optimal solution. We will then examine the time-optimal control of die tend an arm system using the 
reduced-order model. 


3.1 Problem Statement 


Given the dynamical system with state z(t) and control u(t). 


x(t) = F(x(t)) + B{x{t))u{t) 


> 


where 


x{t) 

u(t) 


is a 4-dimensional vector 
is a 4-dimensional vector 


fMO) is a 4-vector-valued function 

is a (4 X 4)-matrix-valued function 

Find an admissible control u(t) which takes the system from the initial state xq to the 
minimum time, i.e. find u(-) to minimize the following cost function: 


Xf in 


■/HD = £ 


dt 


(3.2) 


where an admissible control u(-) is defined to be one such that every component satisfies the following 
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magnitude constraint, 


u 


mi 




max 




or written more compactly 

tz(£) £ 17 for all t (EE [£oi £y] (3-4) 

</ in equation (3.2) is free, and is part of the optimal solution. 

In addition, F(x(t)) and B(x(t)) are assumed to posssess the follosing properties: 

1. fi(x) and b l j(x) are continuous in x, and 

2. dfi(x)/dxi,dbij(x)/dxk arc continuous in x , 

where fi(x], bij(x), Xk are components of F(z), B(x), and x respectively. 


3.2 Application of the Minimum Principle 

Pontryagin’s Minimum Principle (Athans & Falb[3]) furnishes us with necessary conditions which 
the time-optimal control u*(t) must satisfy. Any control u e (t) that satisfies all the necessary conditions 
is known as an extremal condition, and is a candidate for the optimal control. If a time-optimal control 
exists, and if there are more than one extremal control, then the one with the smallest cost given by 
equation (3.2) is optimal. 

In order to apply the Minimum Principle, we will define the Hamiltonian: 

H(x(t), p(t), u(t)) = 1 + p r (£)[F(z(f)) + B(s(£))u(£)] (3.5) 

where p(t) is a 4-dimensional costate vector. 

Let u*(£) be an admissible control which transfers the system from sq to xj, and let x*(t) be the 
corresponding trajectory. In order for u*(t ) to be optimal, it is necessary that there exist a function p*(t) 
such that: 

(a) p*(t) and x*(t) are a solution of the canonical system: 





i 
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i\t) 

Pit) 

satisfying the boundary conditions 

z*(<o) = Xo 
x *(t f ) = Xf 

(b) For all t e (<o, */]• 

p(t), u(t)) < H{x*[t),p*(t), u) for alluGQ 


= «*( 0 ) 

= -^;(x[t),p*{t),u{t)) 


(3.6) 

(3.7) 


(3.8) 



(c) For all t £ [fo, f/], 


H{x[t),p\t), u*(0) = 0 


(3.10) 


This is a consequence of free terminal time and time invariance of the system. 

Athans & Falb[3] presents a heuristic proof of the Minimum Principle, whereas a formal proof can be 

i 

found in Pontryagin e£ai[4]. . f 


3.3 Bang-Bang Control 

Substituting equation (3.5) into (3.9), necessary condition (b) reduces to 

p* T (t)B(x\t))u{i) < p* T {t)B(x*{t))u for all u£U 

t 

or written in component form, 



(3.11) 


(3.12) 
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for all uj satisfying equation (3.3). 


If we define 


9;(0 = 2 6 «j( x *( £ ))p*(0 


1 = 1 


1 4 

-*■ ? * * *) * 


(3.13) 


Equation (3.12) then becomes 


2 u*{t)q*{t) < J2 u jq ]{t) 
i= i i=i 


(3.14) 


The control u (i) which satisfies the above inequality and subject to the cons'raint of equation (3.3) is 


given by 


u*{t) 

u*(f) 




tlmi 


min 


indeterminate 


if q*{t) < 0 

if q]{t) > 0 
if q'fi) = 0 


1 4 


(3.15) 


We see that u*(t) is well-defined by equation (3.15) if there is only a countable set of times Uj £ [to, if) 


such that 


q]{Uj) = 0 


Under this condition, every component u*(t) of the optimal control u (t) is a piecewise constant function 
of time, u*{t) is then known as a bang-bang control, and we say that the problem is Normal. 

If, on the other hand, there is one (or more) subinterval [t m , t n ] within [to, t/] such that 


q*(t) = 0 for some j and all t £ [t m , t n ] 


then u*(f) is not defined by equation (3.15) for t £ [t m , t n ], and we say that we have a singular time- 
optimal problem; the time interval [t m , t n ]is called the singularity interval. 

Hence we see that if the problem is normal, the time-optimal control is bang-bang. For linear 
time-invariant system, we can derive necessary and sufficient conditions for the time-optimal problem to 
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be normal (sec e.g. Athans & Falb[3]) or singular, but for general nonlinear systems, there is no such 
conditions, hence it is very difficult to rule out die existence of singularity intervals before solving the 

problem. 


3.4 Time-Optimal Control of the Tendon Arm System 

For the tendon arm system, die equations corresponding to equation (3.1) are given by equations 

'■ i ' > . , 

(2.60M2.62) which describes the reduced-order model. 

Since the tendons can only pull but not push on the arm, there is a non-negativity constraint on the 

control, and equation (3.3) will now be replaced by 

0 < Ui(t) < Umax t = 1, • • ., 4 (3.16) 


The expression for B{x{t)) can be obtained from equations (2.62) and (2.59): 


If we represent N 1 in equation (2.59) by 


N' 


hn h\2 
frn fa. 


(3.17) 


Then 




[6 4 (i(f)) 


^31 

hi 
hn 
1^21 

Kr 


&32 &33 &34 

642 &42 ^44J 


h 12 
ho 2J 


—Kr/h Kr/h eKr/h 
0 0 —Kr/lj 

hn/h hn/h — (hi2 — ehn)/h 
hai/h h 2 1//2 —{ha — eh2i)/h 


and from equation (2.62), 


-eKr/k 
Kr/k 

(hi 2 — ehn)/l4 

{ha — d^n)/h 


(3.18) 




0 


fort = 1,2, j = 1,....4 


(3.19) 
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Substituting equations (3.18) and (3.19) into (3.13), we obtain the following expressions for q*At ): 

«/ 


* 1(0 


Kr 


9^(0 = Kr 


hnP* 3 (t) -f fi2ip* 4 {t) 

h 

h\\P* 3 {t) + h 2 \p\{t) 

h 


q 3 (t) 


q 4 {t) = Kr 


{h\2 — ehi ,)p3(f) + {h 22 — eh 2 i)p* 4 [t) 

- . — 5 -; — 

(h l2 — ehu)p* 3 (t) + {h 22 — eh 2 l )p* 4 {t) 


(3.20) 




The qAtys will be used in equation (3.15) to determine the value of u (<). Since the sign and not the 
magnitude of q*At) is important, and since K, r,li,i = 1,..., 4 are all positive, we will define a new set of 
q*(t) that can also be used in equation (3.15): 


9l(0 = ~fallPafO +*2lP4(0) 

?a(0 = W 3 M + ^lP^O 

q 3 {t) = —({hn — eh u )p* 3 (t) + (h 22 — eh 2l )p* 4 (t)) 
q* 4 (t) = (*-i 2 — ehu)p 3 {t) + (*22 — eh 2 i)p* 4 {t) 


and the optimal control u*(t) is given by 


«;to 

u*{t) 

«J(0 


- Umax 
= 0 

indeterminate 


if 9y(0 < 0 
ifg*(f) > 0 

if q*{t) = 0 


1 4 


where q At) is given by equation (3.21). 
Note that in equations (3.21), 


§ 1(0 

&o 


92(0 


If we define new variables q* 12 ( 0- 9^(0 8i ven by 


9n(0 = 9*(0 

934(0 = 93(0 


(^1 iPa(0 + *2iP4(0) 

((/112 — diu)p 3 {t) + (^22 — e/i2i)P4(0) 


(3.21) 


(3.22) 


(3.23) 
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Then equations (3.22) can be rewritten as 

if Q 12 M :S= U mtiX , U 2 (f) - 0 

% ■ • 

if q\ 2 {t) > 0; u l(0 “ u 2(0 “ U max (3.24) 

if q * l2 (t) — 0 , u\{t), u 2 {t) indeterminate 

and t t . 

if 934 (f) “v 0 , -'Wj(f) s±:: Umaxi ^ 4(0 ® 

if 934(0 >°. * 4(0 = 0, li 4 (t) = tw* ( 3 - 25 ) 

if 934 W ” 0 > ul{t), u 4 [t) indeterminate 

From equations (3.24) and (3.25), we see that there is a certain relation between u\[t) and u 2 (t), between 
ul[t) and u*(f), except in the case when q* l2 {t) — 0 or 934 (f) = 0. The four control components seem to 
work in pairs, uj(f) and u*(f) forming one pair, u*(f) and u*(t) forming the other. This agrees with tire 
physical situation, in which tendons 1 and 2 form one pair, and tendons 3 and 4 form tire other. 

Necessary conditions (a) and (c) apply directly to the tendon arm system with the appropriate 

definition of the Hamiltonian function. 







Chapter 4. Iterative Solution of the Time-Optimal Control Problem 


4.1 Introduction 


In Chapter 3, we have seen that the Minimum Principle provides us with necessary conditions that 
the optimal solution must satisfy. In particular, manipulation of necessary condition (b) yields equations 
(3.24) and (3.25) which express u (f) in terms of x ( t ) and p ((). If the problem is non-singular, u ( t ) is 
well-defined and theoretically we can solve the time-optimal control problem by eliminating u*[t ) from 
the canonical system given by equations (3.6)-(3.8), and solving the resulting two-point boundary value 
problem to obtain x*(t) and p*(t ), and hence u*[t). But two-point boundary value problems are very 
difficult to solve analytically except for some simple cases. Hence for higher order linear and nonlinear 
systems, we must in general resort to iterative methods to obtain solutions. 

A solution obtained by any iterative method is characterized by: 


1. it is only applicable to a specified initial and final position pair. To obtain solutions for other pairs, we 


have to repeat the entire iterative solution procedure, and 
2. it is expressed as a function of time. 

The first statement means that we have to precompute and store the control trajectories of every 
relevant initial-final position pair, the second means that the control is open-loop and hence cannot 
correct for any departure from the intended trajectory due to, say, external disturbances. These are 
disadvantages, but since the complexity of our system precludes any other solution approach, we have to 
employ the iterative approach and take into account the aforementioned disadvantages in the design of 
the overall control scheme which will be discussed in later Chapters. 

Plant[5] and Mufti[6] provide a surveys of various computational methods in optimal control problems 

t. 

and each contains a long list of supporting references. The criteria for choosing an iterative method for 
our problem are that. 
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1. it is easy to code, and 

2. it can handle singular problems. 

The second point is essential because as mentioned in Chapter 3, the possibility of the presence 
of singularity cannot be ruled out, and in fact, from some preliminary runs using the steepest descent 
method, one pair of controls docs not approach bang-bang, indicating that die pioblcm might be singular. 

There arc some computational methods developed expressly for singular pi oblcms (sec e.g. [7]-[10]). 
But tire Conjugate Gradient method is chosen because 

1. it is basically a first order method, hence its implementation is simple, and 

2. it converges quadratically near the optimum solution, and 

3. it can handle singular problems. 

4.2 The Conjugate Gradient Method 

The first order gradient method is easy to implement but suffers from slow convergence near the 
optimal solution. In 1967, the Conjugate Gradient Method was applied to optimal control problems [11], 
[12]. The convergence rate of this method is superior to tine gradient method with very little additional 
computation per iteration. Pagurek & Woodside[13] and later Quintana & Davison[14] extended the 

method to problems having bounded control constraints. 

We will first describe the Conjugate Gradient method as applied to a free end point, fixed terminal 
time, optimal control problem, and in the next section, we will show how it is adapted to solve our time- 
optimal control problem. 

Problem Statement 
Given the system 

x{t) *= F{x(t)) -f B(x{tj)u{t), x{t 0 )^xo (4.1) 

Find u(t) over die interval Jig, t f ] to minimize the cost function given by 





(4-2) 


J(u(tj) — K(xf{tj) -f- J L(x(t),u(t))dt 


where tj is fixed, and u(t) is assumed ro be unconstrained. 

Define die Hamiltonian 

H(x(t), p{t), u(t)) = L(x{t), u(0) + P r M[ F (s(0) + 5(x(0H0] ( 4 - 3 ) 


Then die necessary conditions as give i by the Minimum Principle are die same as equations (3.6)—(3.10) 
except for the boundary conditions (3.8) which are replaced by: 


x*{to) = so 
P%) = f£(**( 4 /)) 



Solution Procedure 


Define 


H u (x(t), p(t )) 


dH 

du 


(*(0> p(0> u ( 1 )) = B T (x[t))p{t) 



Let superscript i represent the iteration number, and assume that we start with an initial estimate of the 
optimal control trajectory u 1 ^). 

At the ith iteration, 

1. Using u‘(f), integrate the state equation forward from time to to £/, with x(to) = xo, to obtain x l (t). 
Then, substituting x'(t) and u’(£) into the costate equation, integrate it backward from £/ to to with 

P%) = 

to obtain p‘(£). 




(4.6) 

(4.7) 

(4.8) 

(4.9) 

4. Repeat the whole procedure with i = i + 1 until J( ) does not improve significantly. 

Control Constraints 

To take into account constraints on the magnitude of the control as given in equation (3.16), the 
above procedure is modified as follows (due to Pagurek & Woodside[13]): 

1. Assume that VP) is the saturation region of tx*(f); define the scale function 

«#) = 0 for t G Wj, and (4 . 10) 

= 1 elsewhere 

Note: subscript j refers to individual components of the corresponding vector. 

2. When computing/?* -1 , ta ir (f)g < (f) is used in place of 

3. After computing u ! ~^ 1 according to equation (4.9), tt*^ 1 (i) is truncated at the upper and lower 

bounds before it is used in die computation of J{u l+l (t)). 


Compute 


g i m= //„(p ! (t). 



2. Determine conjugate-gradient direction using: 


s i (t) = g i (t) + l3 i - l s i - l (t) 


where 


13 


i — 1 


i i —1 


Jt O - 

f,'g i - ,r (t)9 i - , (Wt 

0 ° 


if i > 1 


• /% * 


i = 1 


3. Compute next control by, 


tt 



u 


Q l s'(f) 


where a 1 ’ is chosen using a one-dimensional search to minimize J(u l + l (t)). 
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Algorithm for the Time-Optimal Problem 


In order to apply the conjugate gradient method as presented in the last section, the time-optimal 
problem as stated in section 3.1 is modified as follows: 

1. A sequence of fixed terminal time, free end point problems are solved instead of the original free 

terminal time problem. 

2. The fixed end point constraint is handled by means of a quadratic penalty function, that is, we solve 

the following problem: 

Given the dynamical equation described by equation (3.1), find a control u(t) £ ft so as to minimize 
the following cost function: 

J = — x l) (4.11) 

subject to z(fo) = so, with fo, t/ and £/ given. 

If tf is too small, i.e., tf < T min , where T m i n is the minimum time solution, the system cannot reach x/ 
with the control in ft, hence J will not be close to zero. As tj increases and approaches T min , however, 
the optimum J value will decrease, and the smallest tf such that J is zero (within a certain tolerance) is 
the solution to the original time-optimal problem. 

Choice of tf 

We can always start with a very small tf and gradually increase the value of (/, but this will take too 
long as each round {i.e. solving the modified problem with a given tf) by itself takes a long time (when 
run on a PDP 11/34 mini-computer). Hence we will make use of the special structure of the optimal 
control to provide an estimate of T m i n . 

It was found from some preliminary runs that in an optimal solution, one pair of controls, either 
u\ and U 2 or U 3 and 1 x 4 , always approaches bang-bang with only one switching, and the form of the 
other pair will depend on the relative magnitudes of Of and <f>f, which define the final position of the 



arm (henceforth we will assume that = 0, i.e., we are interested in moving the arm from an upright 
position to any specified final position';. Although the two pairs of controls are coupled through the system 
equation, the coupling is not very strong, and one can clearly identify the pair u t and u 2 as affecting the 
angle 0 much more strongly than u 3 and u 4 , and similarly, the pair u 3 , u 4 affects <j> much more strongly. 
Hence the time taken for the arm to move from 0 = 0 to 0 = 0 f is determined mainly by u, and u 2 , and 
is only slightly affected by u 3 and u. u the same applies to <f> with u 3> u 4 exchanging roles with u ( , u 2 - 

Hence to find the time taken for .lie ann to move from 0 = <j> = 0 to 0 = 0 f , <t> = 0, we will keep 
u 3 and tt 4 to be zero (thereby ensuring <f> to stay 0 throughout) and find a bang-bang control that will take 
0 to 0/ this is a much easier problem to solve because we need only to search over the switching time, 
which is only one-dimensional and can be easily done manually. Similarly we can find the time taken to 
move from 0 = <j> = 0 to 0 = 0, <f> = <i>j. The larger of the two values found above will be taken as an 
estimate of T min . This value was found, in general, to be greater than T rnin by about one to three time 
steps (each time step is 5 msec). Hence the initial choice of t, is taken to be three time steps smaller than 
the estimated T min , and we need to solve at most three rounds of the modified problem to obtain our 


solution. 


Choice of Q 

Q ;s chosen to be diagonal and serves to weight the different components of z individually. We chose 
the qa ihat corresponds to the angle that is mainly affected by the bang-bang pair of controls to be twice 
the value of the rest. This is because as the iterations proceed, it becomes more and more difficult to 
reduce that error term, as we are trying to reduce the transition time of die bang-bang control, making q tl 

larger helps. 

Choice of Initial Guess of u{t) in the Conjugate Gradient Method 


The initial guess is chosen to be 
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u,(t) p=s 0 for i = 1,..4 and for allf G [to, </] (4.12) 

and wc started with several iterations of steepest descent before switching over *o die conjugate gradient 
method. 

Method of finding a 1 

As mentioned in the procedure for the conjugate gradient method, a 1 is chosen using a one- 
dimensional search technique. The method we used is to fit a parabola to three points of a’s, chosen so 
that the minimum of the parabola falls within die two extreme values of the a’s, a 1 is chosen to be die 
value of a that minimizes the parabola. 

■ .- 

<e-■ i « • 

4.4 Approximation of the Optimal Solution 

The results obtained using the conjugate gradient method for a particular final position is given in 
r- figure 4-1. From this figure, we can see diat the pair u 3 and u 4 approaches bang-bang with one switching, 

but not the pair u\ and uq. 

The optimal solution can be approximated by straight line segments as shown in figure 4-2, the stae 
_ trajectories for the optimal and the approximated control are shown in figure 4-3, and we see that the 

I response due to the approximated control compares favorably with the optimal solution. Any deviations 

! from die desired state at die terminal time will be handled by another closed-loop control law which will 

_ be switched in after the open-loop control is terminated. 

The general form of die optimal control and its approximation will be elaborated in Chapter 6. 

....... , ....... -X- 
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Chapter 5. 


Regulation at the Final Position 


5.1 Introduction 

Since the arm is attached to the base plate by a three degree-of-freedom "joint", positive steady-state 
tensions in the tendons are required to maintain the arm at any specified final position. The required 
control currents can be calculated by setting 

*/ = /(*/,«/) = 0 


where xj is the specified final state of the system. 

A iif that satisfies the above equation will be called a steady-state control ior the set-point x/. 

If the arm is initially at the required final state xj , then uj will keep the arm at Xf as long as there 
is no external disturbance. However, any slight disturbance will cause the arm to move away from this 
equilibrium position because the equilibrium achieved by applying constant open-loop controls u f is an 

unstable one. 

Moreover, the transient phase open-loop control that brings the system from initial to final state 
is based on a reduced-order model of the system, and also in order to implement it, it is necessary to 
approximate the form of control by straight line segments. The open-loop control can only be stored at a 
few points and the control law at other points is derived by interpolation. Hence at the end of the transient 
phase during which open-loop control is applied, the final state reached by the system is not x f , but rather 

somewhere in the vicinity of it. 

i 

In view of the above, closed-loop feedback control is required to 

1. bring the system to the desired final state x/, 

2 . maintain the system at x s for any amount of time. 

5.2 Linearized Model 
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Figure 5-1. Block diagram for the closed-loop feedback control scheme. 


Let xj denote the desired final state, and uj denote the steady-state control that satisfies equation 

(5.1). 

Define 

1. State perturbation vector 6x(t): 

6x(t) — x (t) — xf 


2. Control correction vector 8u{t ): 


6u(t) = u(t) — Uf 


Then the control objective can be stated as follows: 

Given 6x(t), find 6u(r), r > t such that future state perturbation vectors 6x(t ) are as small as 

1 

possible for all r E [f, oo), or find a controller, as depicted in figure 5-1 that will accomplish this. 

We will employ the linear-quadratic approach to designing the controller. Since we are trying to keep 
the system at a fixed set-point, this is also known as the linear regulator problem. 

First we must derive the relationship between 8x(t) and 8u(t): 
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x(t) and u(f) arc related by the system equation: 


x(t) = f(x{t), u(*)) 


(5.2) 


Expanding f(x(t), u(f)) about x/, u/ in a Taylor scries expansion, 


f- .. i 


f(x(t), u{t)) = f{x f , Uf) + ^r{x f , Uf)8x(t) + g^( x f> u /) Su ( i ) + h o t 


(5.3) 


vlicre h.o.t. denotes the higher order terms in the Taylor scries expansion. 


Since 


and 


6i(t) = i(t) — if 


if = f{x f , u f ) 


we have, 


Si[t) — ^( Xf,Uf)6x{t ) -\- < ~(xf, u f)5u{t) + h.o.t 


(5.4) 


Define 


dx 

d± 

du 


{Xf, Uf) 

(*/. u f) 


and assuming that the higher order terms are negligible, we obtain to first approximation that 


(5.5) 


6i[t) = A8x(t) + B8u(t) 




(5.6) 


For the remainder of the Chapter, the 5-notation will be dropped for simplicity, and the linearized 


model will be represented as 


i[t) — Ax(t) -|- Bu(t) 


(5.7) 




5.3 


The Linear Regulator Problem 
Given die linear time-invariant system 

x(t) = Ax(t ) Bu(t) (5.8) 

and its initial condition 20 , find u(t) such Uiat die following quadratic cost functional is minimized 

/•OO 

J= ( x T (t)Qx(t ) -f- u T (t)Ru(t))dt (5.9) 

J 0 

where Q — Q T > 0, R — R T > 0. 

Derivation of the solution to the above problem can be found in Kwakcrnaak & Sivan[15]. It is 
shown that the optimal control u (f) is given by 

u{t) = -Gx{t ) (5.10) 

where 

G = R~ l B T P (5.11) 

and P is the solution of the following Algebraic Riccati Equadon (ARE): 

0 = —PA -A t P-Q + PBR~ 1 B t P (5.12) 

If the original system is completely controllable, then the solution to the above ARE exists. In 
addition, since we are assuming that we arc observing all the states, the system is completely observable, it 
can be shown that die feedback system is asymptotically stable (sec e.g. Kwakcrnaak & Sivan[15]). 

We will now consider die choice of the weighting matrices Q and R in the cost function given by 
equadon (5.9): 
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In general, the selection of Q and R is not a simple matter; they are usually chosen on the basis 
of engineering experience coupled with simulation runs of the resultant system using different weighting 
values. In most practical applications, R and Q are chosen to be diagonal because in this way we can in¬ 
dividually penalize specific components of x(t) and u(f). We will likewise choose R and Q to be diagonal. 

Since there is no reason to penalize any one component of u(t) more than the- others, R is chosen to be 
of die form pi, where p is a positive scalar. Once Q is chosen, by adjusting p, we can vary the relative 
weighting between the state perturbation and control perturbation vectors. 

Specifically, the effects of p are: 

l the smaller p is, the faster is the state perturbation vector x(t) reduced to zero, this corresponds to the 

poles of the system being pushed to the left of the s-plane. 

2. the smaller p is, the larger will be the feedback gain matrix, i.e. G in equation (5.10), this corresponds 

,*-«***** 

to large control magnitude. 

Hence there will be a tradeoff between the speed of response and the amount of control to be put into the 
system. 

When we consider the maximum allowable magnitude of control perturbation, we must bear in mind 
the control constraint which is given by 

0 < Ui(t) < Umax for t = 1,..., 4 (5.13) 

where m(t) here is the total control input to the system. 

© 

In our case, since we are interested in reducing the position error to zero as fast as possible, we 

choose not to penalize the velocity terms. Hence <? is of the form, 

k 

0 3 

and p is chosen so that the slowest pair of poles is only slightly underdamped so that there will not be 




much overshoot. 





Taking all these into consideration, and after some trial and errors and looking at the closed-loop 
eigenvalues and resultant runs, p is chosen to be 0.2. The values chosen are not optimal, but they repre¬ 
sent a reasonable choice and yield an acceptable response. The response can of course be improved upon 
by further fine-tuning, but we are not putting any emphasis on it at this stage. 

5.4 Determination of Steady-Stale Control Input 

The steady-state control u f (t) required to hold the arm at any position, say 0/, 4>f , can be ob¬ 

tained from equation (5.1), where xj = (0/ <pj ip/ 0/ <f>/ 4>/) T ■ Since x(t) is a 6-vcctor, we will 
obtain six algebraic equations from equation (5.1), but the first three do not involve u{t) and only give us 

« t • 

x 4 = x 5 = xg = 0 which corresponds to 0/ = <Pf — *Pf — 0- 

Therefore from equation (5.1) and by substituting the values of x f = (0/ <p/ ip/ 0 0 0) r into 
it, we can obtain three algebraic equations involving the four scalar controls uji, i — 1 > • ■ 4 > by solving 
these three equations, we can obtain Uf. However, note that we have one degree-of-frecdom in choosing 
uj subject to the three equations and the control constraint given by equation (5.13). By specifying any 
one of the uji s, we can uniquely specify the other three. 

There are two ways of taking advantage of this one degree-of-freedom: 

1. we could, for each position, find the minimum values of control that will satisfy the three equations as 

well as the non-negativity contraint. Effectively we are setting one of the u/i s to be zero and solving 
the three equations for the other three «/,’s. The one to be set to zero is chosen such that all s are 

non-negative. 

2. we could introduce another algebraic equation involving the u/*’s, and by solving these four simul¬ 

taneous equations we can get unique values for the u/ t ’s. Specifically, the equation introduced 
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Since all the u fi 's are non-negative, the larger the value of k, the larger are the u;, s. In this context, 
this degree-of-freedom is thought of as providing us with the freedom of choosing the overall control 

level. 

. i 

The first method is attractive in that it provides us with a way of specifying minimum control to keep 
the arm at any desired position, since we do not want to expend unnecessary energy holding the arm at a 
fixed position. However, since one of the components will be zero, or very near zero, the non-negativity 
control constraint is easily violated when we apply the feedback control law as }iven by equation (5.10). 

On the other hand, the second method provides us with a way of specify mg uj at any position such 
that £ Ufi at all positions within the working space is the same. This is attractive because it was found 
that if this is so, then the "main" components of the feedback gain G as given in equation (5.11) do not 
vary significantly for all the positions. This point will be elaborated further in Chapter 6. 

Hence the second approach is used, k is chosen such that for any position within die working space, 

the u/i’s obtained by solving the four simultaneous equations are all non-negative. 

The value of A: found and used is 7, and the most critical position (with one of the u f - s nearest to 

zero) occurs approximately at a = 45°, /3 = 10°, ip = 4x. 








Chapter 6. Implementation and Simulation of the Overall Control Structure 



6.1 Introduction 

As stated in Chapter 1, we are interested in moving the arm from an upright position to any specified 
final position. The overall control scheme for this movement is divided into two phases. In die first phase, 
open-loop time-optimal control approximation is applied to bring the arm to the vicinity of the specified 
final position. In the second phase, a closed-loop linear feedback control law will be switched in to bring 
the system to the desired final position and to maintain it there. 

In order to implement this control scheme, we must have available the open-loop control and the 
feedback gain for every final position that can be specified. Since the computation time of the former is 
too long and the memory requirement for the latter is too large for them to be calculated on-line using 
the POP 11/45 which is used for the control of the tendon ann, they must somehow be precalculated 
and stored- Since it is impossible to store the values for every possible final position, which arc infinite 
in number, we need to partition the entire state space into regions and precompute the open-loop control 
trajectory and the feedback gain of a representative point of each region and store them in tables of some 
sort. As for the other points in the region, we can either interpolate or use die same value throughout a 
region. The latter approach is employed due to: 

1. the feedback gain does not change significantly within a region, and 

2. there is no satisfactory way of interpolating die open-loop control, and since feedback control is 

employed in the second phase, we rely on it to bring the system to the desired state, and 

3. it is simple. 

The next two sections describe means of representing and storing the open-loop control trajectories 
and the feedback gains. The last section describes briefly the program written for the implementation of 
the overall control scheme. 
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6.2 Representation and Storing of Open-Loop Time-Optimal I rajectorics 


Symmetry of the Control Trajectories 

'Die design and construction of the tendon arm is such that it restricts die range of movement of the 

arm. In this thesis, this range will be 6 ken as 


0 <Q < 


IT 


o <P < 2ir 

- <V> < 7 

4—^—4 


(6.1) 


where a. 3. ii> are as defined by figure 2-4. 

We will divide this space into four quadrants with die following correspondence: 

0 </? < f 1st quadrant 

1 < 3 < r 2nd quadrant 

7 T < /3 < 3rd quadrant 

ai < 3 < 27r 4th quadrant * # 

2 

For the time-optimal trajectories, there is a symmetry among the four quadrants such diat only those 
of the first quadrant need to be stored and those of the other three quadrants can be obtained from the 

corresponding trajectory in the first quadrant. 

Let Ui[t ), i — 1,..., 4 be the control trajectory that will bring the system from the initial position 
to a final position defined by 0 = 9 f , <t> = ft, where (0 f , 4>j) is in the first quadrant (recall that the time- 
optimal control is obtained using the reduced-order model and hence t/> is not relevant). 

Then, to obtain the control trajectory for 

T 0 = — 0 j , 4 > == — 4 >/\ exchange u\(t) and u 2 [t), exchange U 3 (£) and u 4 (t). 

2. 0 = — 0f y 4> = <!>/> exchange u\(t) and tt 2 (0» do not exchange U 3 (t) and u 4 (t) 

3 . 0 = 0 f ,4> = —4> f \ do not exchange u\ (f) and u 2 (0, exchange u 3 {t) and u 4 {t). 

Hence in all the discussion that follows, we will take the final position to be in the first quadrant. 
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Figure 6-2. Form of the bang-bang pair of controls 


Form of time-optimal control 


As stated in section 4.3, it was found that, in general, one pair of controls is bang-bang and the other 
pair is not (both pair of controls could be bang-bang for certain values of 0/ and 4>j). Which pair it is that 
is bang-bang depends on the relative magnitude of 9j and <p/. 

In general, the pair that is not bang-bang can be well-approximated by straight line segments, and 
they can be of any form as shown in figure 6-1. The pair that is bang-bang is of the form that is shown in 
figure 6-2. Hence any pair of controls can be represented by the numbers h u h 2 , h, t 2 , £ 3 , tf as shown in 
figure 6-3. 

There are two ways of representing the open-loop control trajectory for any final position: 

1. Represent both pairs by the general form shown in figure 6-3. By choosing appropriate values for h u , 
h 2 u tu, t 2i , t 3i , t/, i = 1,2, we can represent any of the forms given by figure 6-1 and the bang- 
bang control of figure 6-2. (i — 1 represents u\ and u 2 , i — 2 represents u 3 and 1 x 4 ). Since in 
implementing the control scheme with a digital computer, the time axis is discrete, hence the t are 
integer numbers. Using this scheme, we need a total of 4 real numbers and 7 integer numbers to 


* .nit 
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figure 6-1. Various forms of the non-bang-bang pair of controls 
represent the control trajectory of each final position. 

2. Represent the non-bang-bang pair by the general form, and represent the bang-bang pair by one 
number, that of the switching time. Hence in this scheme, we need 2 real numbers, 5 integers and 1 

bit to indicate which pair is bang-bang. 

The first method is chosen because it is straightforward to code and at this stage we are only trying out 
the overall control scheme using simulation and hence the partitioning into regions is very coarse and is as 
shown in figure 6-4. We arc not too concerned yet with conserving storage. 







Figure 6-3. General representation of any pair of controls 


In practical implementation, we need of course to partition the state-space into a finer grid, hence 
reducing the storage requirement per point will be one of the prime concerns. We can then consider the 
following two ways of saving storage: 

1 . With the sampling rate (5 msec) used, the maximum time step corresponding to t f is less than 100, 

hence we can pack two time values ( e.g. fi and < 2 ) into one word. 

2. In actual system implementation, the control will be applied to the motors via digital-to-analog con¬ 

verters which takes integer value as input, hence the control values can be stored as scaled integers 
instead of real numbers. 

If these two modifications are implemented, only 8 words for the first method and 5 words for the second 
method are required per point. 

ft 



6.3 Representation and Storing of Feedback Gains 

The feedback gain G of the linear regulator design is a 4 X 6 matrix. If i = l,..., 4, j — 
1,..., 6, represents the component of G, then g tj is the contribution of Xj to u it t.e., 
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Figure 6-4. Partitioning used in the simulation run 



where Ui is the steady-state control. 

Hence we can partition die matrix G into main components and cross-coupled components. 

For ui and u 2 , since they directly affect 0 and 0, and only indirectly (f> and <j>, we will treat 011 , 021 , 9 \4, 924 
as main components. 

Similarly for u 3 and u 4) since they directly affect </> and <j>, we will group 932 , 942, fcs, 945 as main 


components. 
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Figure 6-5. Cross-hatched area showing the main elements of matrix G 

Since all four controls directly affect ip and ip, we will treat 9 , 3 , & 6 , i — 1 ,..4, as main components. 
Hence as indicated in figure 6-5, the cross-hatched elements are the main components. 

Table 6-1 shows the feedback gains for the various positions indicated in figure 6-6 and for ip = 0. 
From this table, we can see that the values of the main components do not vary much for different 
positions, and it is only the cross-coupled terms that change significantly, for example, compare 921 , 9 n of 
points 5 and 6, there is as much as an order of magnitude of difference. 

Table 6-2 shows the feedback gains for position 3 (a = */ 6 , /? = 7 r/ 4 ) but with different values of 
ip. It can be seen that all components of G do not vary significantly for different ip, hence we will take 
them as the same and equal to those at ip = 0 . 

Table 6-3 shows the feedback gains for position 3 and its corresponding positions in the other three 
quadrants. To a first approximation, we can obtain G of the third quadrant from the first quadrant, and of 
the fourth from the second as follows: 

exchange row 1 and 2, row 3 and 4, and 

change the signs of all the elements except those of columns 3 and 6. 
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Figure 6-6. Figure showing various final positions used in Table 6-1 


For implementation purposes, we will treat the main components of G to be the same for all posi¬ 
tions in the four quadrants, using those of the upright position, and store the non-main components for 
position 1, 3, 5 and 6 and their corresponding positions in quadrant 2, i.e., the partitioning into regions is 

the same as for the open-loop control. 

6.4 Structure of Overall Control Program and its Implementation 

The working space of the arm is defined by equation (6.1) and is partitioned into regions as shown in 
figure 6-4. The open-loop control and feedback gain of the representative point, called the center, of each 

region are stored as described in the last two sections. 

When a set-point command is issued, the program will first determine which region the final position 
is in after which the entire open-loop control trajectory and the feedback gain G for its center are deter- 
mined, these will be used for the final position specified. At the same time, the steady-state current at the 

final position is calculated. 

The open-loop control is then applied to the system: at each time step, generated by an interrupt 










from the real-time clock, a control vector is output to the system. At the end of the first phase, determined 
by the final time of the open-loop control, the closed-loop linear feedback law will be used: at die occur¬ 
rence of each interrupt, the state of the system is read via die A to D, from which the state perturbation 
vector 8.r is calculated, and the control correction vector is calculated by 



where v/ is die steady-state control vector. 

This u is dien output to the system. 

Because the physical tendon arm system is not ready, die overall control scheme will be simulated on 
the PDP 11/45 computer. But the program is written as if it is a real time system except that a software 
subroutine is being substituted for the arm, and the time scale is expanded due to die length of time 
required for the subroutine. The block diagram for the program is given in figure 6-7. 

Figure 6-8 shows the state trajectories for three different final positions. 
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Figure 6-7. Block diagram for the overall control program 















Figure 6-8. Trajectories for three different final positions 
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Table 6-1 Feedback gains far the various positions shown b 

Figure 6 * 6 


1 «*»0° , (i *0°, i|>. 0* 

-4.0294D+00 -2.11030-01 1.50440+0.0 

4.0294D+C0 2.1103D-01, 1.50440+00 

-2.e960D-01 -4.83190+00-1.53630+00 
2.8960D-01 4.E319D+00 -1 .53630+00 

Z oC'l5°.p*4S* 

-3.49400+00 3.6891D-C1 1.C416D+0C 

3 . 5 ee 9 O + C0 7.44370-01 1 .04920+00 

1 .70860-01 -4.3907D+00 -1 .03960+00 
5.5215D-01 4.3673D+00 -1.0971D+00 

$ oc * 30° . p - 45* 

-3.63660+00 1.03230+00 1.03810+00 

3.70280+00 1.17660+00 1.04800+00 

9.27020-01 -4.44830+00 -1.01310+00 
5.69050-01 4.40910+00 -1.1180D+00 

4 oc : 45* p * 45* 

-4.2914D+00 1.6954D+00 1.04170+00 

3.88810+00 1.6345D+00 1.04020+00 

2.0307D+00 -4.58050+00 -9.93030-01 
3.89140-01 4.60250+00 -1.12670+00 


6.06780-01 -2.23330-02 8.3086D-02 
6.0678D-01 2.2333D-02 8-30860-02 
1.80810-02 -7.53780-01 -$.48500-02 
1.808.1 0-02 7.53780-01 -8-48500-02 


5.39200-01 4.26700-02 6-9065D-02 
5.95550-01 8.72050-02 6-91740-02 
2-65770-02 -6.87810-01 -6-9136D-02 
4.17200-02 7.34140-01 -7.2071D-02 


■5.2884D-01 1.10980-01 6-9478D-02 
6-3000D-01 1.41530-01 6-9113D-02 
9.91820-02 -6.52230-01 -6-8077D-02 
3.3458D-02 7.44560-01 -7-32970-02 


-5.4604D-01 1.70140-01 7-08240-02 

6.7243D-01 2.01660-01 6-B619D-02 

1 .9637D-01 -6.1743D-01 -6-7677D-02 
-5.84560-03 7.61070-01 -7-3971D-02 






5 o< s 30* , (b - 0° 


-3.341SD +00 1.3S72D+ 00 1.06030+00 

3.62330+00 1.8534D+00 1.09630+00 

-2.5594D-C1 -4.914SD+C0 -9.06540-01 
3.9595D-01 4.74320 + 00 -1 .13620+00 

6 30 * , > 6 

-3.76330+00 -1.30650-02 9.7825D-01 

4.02620+00 3.54340-01 1.00330+00 

8.2385D-01 -3.88340+00 -1.15230+00 
1.3934D+00 4.16610+00 -1.0909D+00 

7 * s45* , p * 22 b p 

-3.90040+00 2.67390+00 1 .11030+00 

3.45750+00 2.5295D+00 1 .0946D+00 

1 .04340+00 -5.0584D + 00 -8.36550-01 
1 .21790-01 5.27180+00 -1 .1241D+00 

& oc * 45* . p - 67-5 # 

-4.16030+00 7.13180-01 9.25940-01 

4.5281D+00 9.1009D-01 9.99790-01 

2.36930+00 -3.8769D+C0 -1.1557D+00 
1.2249D+00 4.01570+00-1.12830+00 


-5.52950-01 1.67310-01 7-0848D-02 

5.7216D-01 2.12130-01 7.3349D-02 

-7.6211D-03 -7.14830-01 -6-21950-02 
3.66990-02 8.09380-01 -7.30S3D-02 


5.1258D-C1 -9.66560-04 6-55430-02 
6.7718D-01 3.68480-02 6-5561D-02 
8.1149D-02 -6.09830-01 -7-56130-02 
1.11880-01 6.69080-01 -7.34580-02 


■5.5416D-01 2.86320-01 7.55400-02 

6.02140-01 2.94110-01 7-35030-02 

1.08650-01 -6.72510-01 -5-8113D-02 
-1.2945D-02 8.7344D-01 -7-2237D-02 


-5.08270-01 6.62690-02 6-29460-02 

7.45590-01 1.12040-01 6-4784D-02 

2.2660D-01 -5.37390-01 -7-7228D-02 
7.1972D-02 5.44590-01 -7-5914D-02 
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Table 6-£ Feedback, gain for positions with <* = 30 # , /»> s 

and different values of t|> 


I tp = - 30 ° 

-3.71230+00 1.0G24D+C0 

3.73140+00 1.15060+00 

9.25530-01 -4.35680+00 
5.71940-01 4.28930+00 

£ *J> • 0 ° 

-3.6866D+00 1.03230+00 

3.70280+00 1 .17660+00 

9 ,27020-01 -4.44830+00 
5.69050-01 4.40910+00 

3 tl) ' + bO* 

-3.6557D+00 1.06440+00 

3.67060+00 1.20220+00 

9.2745D-.01 —4.5415P + 00 
5.63790-pi 4.53720+00 


1.05720+00 -5.301SD-C1 
1.06100+00 6 .33140-01 
9.83310-01 1.00100-01 
1.10160+00 3.42350-02 


1.03810+00 -5.2684D-01 
1.04800+00 6.30000-01 

-1,01310+00 9.91820-02 

-1 .11800+00 3.3458D*02 


1 . 01930+00 -5.26940-01 
1.03500+00 6.2642D-01 

-1.04110+00 9.82310-02 

-1.13220+00 3.25310-02 


1 .05280-01 7.08970-02 
1 .37280-01 6 * 9960D-02 
6.41030-01 -6*61900-02 
7.27660-01 -7.23090-02 


1.10980-01 6*94780-02 

1.4153D-01 6•9113D-02 

-6.52230-01 -6*80770-02 
7.44560-01 -7.32970-02 


1.16920-01 6.81260-02 
1.45770-01 6.82660-02 
-6.63710-01 -6*98760-02 
7.62480-01 -7*41580-02 







Table 6-3 Feedback gains for oc= 30°, fb=4e>° IE E 

and ite corresponding positions in /*\^\ 

the other 3 quadrants “ \£y 

I I 


X 

-3.68660+00 1 .0323D+00 1 .0381D+00 

3.7028D+00 1.17660+00 1.0480D+00 

9.27020-01 -4.44830+00 -1.01310+00 
5.69050-01 4.40910+00 -1.11800+00 

I 

-3.8908D+C0 -1.15240+00 1.05070+00 

3.61380+00 -4.72C50-C1 1.00910+00 

-1.25740-01 -4.18340+00 -1.16820+00 
1.4615D+00 4.65880+00 -9.91540-01 

■II* 

-3.7028D+C0 -1.1766D+00 1.04800+00 

3 .63663+00 -1.0323D+CC 1.03810+00 

-5.69C5D-C1 -4.4G910+C0 -1.11600+00 

-9.2701D-01 4.44S3D+00 -1.01310+00 

JL 

-3.6238D+00 4.7528D-01 1.0084D+00 

3.8721D+00 1.1504D+00 1.05120+00 

-1.44440+00 -4.6586D+00 -9.91580-01 
1.39260-01 4.1833D+00 -1.1683D+00 


5.28840-01 1.10980-01 6.94780-02 

6.30000-01 1.4153D-01 6*91130-02 

« 

9.91820-02 -6.52230-01 -6*80770-02 
3.34580-02 7.4456D-01 -7*32970-02 


-5.44070-01 -1.25120-01 7.04840-02 

6.2405D-01 -7.03760-02 6*66320-02 

-2*19930-02 -7.080BD-01 -7.5408D-02 
1.18710-01 7.03420-01 -6.79170-02 


-6.3000D-01 -1 .41530-01 6.9H3D-02 

5.2S84D-01 -1.10980-01 6.94780-02 

-3.3459D-C2 -7.44550-01 -7.3297D-02 
-9.9182D-02 6.5223D-01 -6*80770-02 


-6.2393D-01 7.1127D-C2 6.6653D-02 

5.4358D-01 1.24900-01 7.04660-02 

-1.1830D-01 -7.08420-01 -6.79140-02 
2.20270-02 7.08140-01 -7.54070-02 






Chapter 7. Conclusions 

7.1 Summary 

In tliis thesis, a mathematical model describing the dynamics of the tendon arm system has been 
developed. From this, we obtained a reduced-order model of tile system and applied the Minimum 
Principle and the conjugate gradient method to obtain the time-optimal solution. It was found that the 
optimal solution is not bang-bang but that it contains singular arcs. But it was also found that these 
singular arcs can be approximated very well by straight line segments, this approximated control is then 

utilized to form part of the overall control scheme. 

The open-loop tendon arm system was found to be unstable, and hence to maintain the system 
at any state, closed-loop feedback control is required. The feedback law was designed using the linear 
regulator design procedure, linearizing the nonlinear dynamics about the final state and the nominal 
control required to keep the system there. 

The two control schemes are combined with the first phase being open-loop time-optimal control, 
bringing the system from its initial state to a waypoint in the vicinity of the final state, the second phase 
then employs the closed-loop control law to bring the system to the final state and to maintain it there. 

It was intended initially to implement the overall control scheme on the actual physical system, but 
due to unforeseen circumstances, this was not possible, instead, digital simulations of the systcttt With the 
control scheme implemented were done. 

7.2 Areas for further work 

There are a few directions that we can go from here: 

1. Implement the control scheme on the actual physical system this is the most natural extension to 
the present work. However, before this can be done, there are a few problems to be taken care of: 






a. The control vector of our problem is formulated in terms of input currents to the motors. The 

drivers for the tendon arm motors, however, are voltage amplifiers, lienee we have to reformu¬ 
late and solve our problem in terms of voltage inputs. This can be easily done however, and the 
way to do it is shown in Appendix F. 

b. The linear regulator design assumes full state feedback. For the tendon arm , we have only angle 

measurements but not velocity measurements, we need to find some means of constructing 
the full state (the simplest way, of course, is to use backward differencing of the angles to 
approximate the velocity terms). 

c. In the simulation of the control scheme, a very coarse grid is utilized to partition the state space. 

In actual implementation, a finer grid has to be used, and the problems of how many grid 
points to use and where to place them have to be considered. 

Investigate other means of simplifying the model — the biggest disadvantage of the present control 
scheme is that the third degrec-of-freedom , namely, ip, is not being controlled during the first phase 
of movement, this is due to the approach employed in simplifying the system equation. It was found 
that the coupling between 6 and <p is not very strong, thus it may be possible to simplify the system 
equations while retaining the full order dynamics. 

The motivation of using time-optimal control initially is because of its bang-bang solution nature (i.e. 
in the absence of singularity). It would be interesting to formulate the time-optimal control problem 
as one having a discrete control set constraint, i.e., 

Ui{t) £ {0, u moi } 

and find out what the form of the optimal solution is. It should also be interesting to formulate the 
time-optimal problem based on the full order model and solve it, if possible, to sec whether it is 
bang- bang. 

In our control scheme, we have utilized the measurements of the angles 0, <p, and ip but not the four 
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motor shaft angles. Investigate other control strategies that will take advantage of the availability of 
all seven angles. 
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Appendix A. Deriving the equations of motion of the system when either pair of 
tendons is completely unwrapped from the arm 

Due to the way the four tendons are wrapped around the arm, at any one '.imc it is possible for only 
one pair to be completely unwrapped. Hence th.cre arc three different sets ol equations describing the 
motion of the system depending on the values of to + A and -f A' (refer to figures 2-7(a) and 2-8(a) for 
the definitions of u>, A, u /, A', where R; is now die point at which a tangent from Pi touches the arm, all 

projected onto the x' — y' plane). 

The th ree cases correspond to: 

1. u -f A < 3 tt/ 4 and J + A' < 3tt/ 4, both pair of tendons are properly wrapped on the arm, this is 

the normal mode of operation. 

2. w.-f A> 3 t r/4 and J + A' < 3tt/ 4, die first pair, corresponding to tendons 1 and 2, is completely 

unwrapped, whereas the second pair remains wrapped. 

3 w _j_ x < 3 tt/ 4 and w' -f A' > 37r/4, the first pair remains wrapped, whereas the second pair is 
completely unwrapped. 

The equations of motion corresponding to case 1. have been developed in Chapter 2; those of the last two 
cases will be developed in this Appendix. 

A.l Tendons 1 and 2 are completely unwrapped 

When w + A > 37r/4, where u) and A are still being defined by equations (2.7) and (2.8), tendons 1 
and 2 arc completely unwrapped, the situation is shown in figure A-l. 

-+ -* 

The directions of F\ and F 2 (the tensions in tendons 1 & 2) arc now given by Q\P\ and Q 2 P 2 
respectively, and equations (2.12)—(2.13), (2.17)—(2.18) arc modified to 
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Figure A-l. Schematic diagram showing the arm and tendons 1 & 2(projected onto the x' — y' 
plane) when u> + )v > 3ir/4. 
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Equation (2.35) now becomes: 


Resultant torque acting on the arm about point O 


OQi X F\ -f OQ 2 XF 2 + OR 3 XF 3 + OF 4 X F 4 + OG X mg 


Fi * Fo - - Fa 

J 1 /-*^\ v > n t J 2 ^ /a n 1 J 


IQ.F, 


OQi x q,p, + 


Q 2 F 2 


OQ 2 X Q 2 P 2 


IF3P3I 


OP 3 X F3P3 


+ 


f 4 


IF 4 P 4 
iT x + jT 2 + kT 3 


OR 4 X F 4 P 4 + mpOG X GD 


(^ 3 ) 


where 


b 









0± —pasinO — abcos9cosip + 7 ^ — pas\n9 + abcos0cosip 

M>/2 J 1 

-|- [ps sin <t> cos 0 rin(u/ + X') — z 3 s( cos <j> sin ip — sin 9 sin <p cos ip)] 
L 3 1 

4 - — sin<£ cos 0 sin(u/ -f- X r ) -f- Z 4 s(cos <p sin ip sin 0 sin <p cos ip)] 

L 4 

-f mgd{ sin <p sin ip 4- cos <p sin 0 cos ip) 

"1 I" 

— -—- pa sin # 4- ab cos # sin ^ ~ ~~ P a & a ^ cos ^ V* 

MV2 J MV2 J 

4 * ^2 —ps sin (f> cos# cos(u/ 4" ^0 — Z 3 s(cos <j> cos ip 4" ^ S * n V> VO] 

L 3 L 

_|_ ^4 £—ps sin <f> cos 0 cos(u/ 4" ^0 4" ^4 S ( C0S 0 cos V* ~f“ s * n ^ 0 VO] 

L4 

4- ragd(sin</>cost/> — cos <j> sin#sin 


f —1 _)_ — pa cos 0(cos ip + sin ip) 

\Li L 2 J ^ 

4- ( — 4- — Jps[sin<^sin 0 cos(X / + //) — cos </> sin(X' 4 ~ aOI 
V ^3 L14J 


(AA) 


(A. 5 ) 


In equations (A.4HA.6), L\ and L 2 are as defined in equations (A.l) -(A.2), the others are defined as in 
equations (2.19)—(2.32). 

A.2 Tendons 2 and 4 are completely unwrapped 

Following the same procedure as in section A.l, when u/ 4~ X / > 3 tt/ 4, the directions of F 3 and F 4 
will be given by Q3P3 and Q4P4 respectively, and 






L3 — 13 — Q3P3 


[(—s cos <f> cos ip — s sin <p sin 0 sin ip -— p) 2 

s/2 

+ (s cos <p sin ip — s sin <p sin 0 cos tp -\ - p ) 2 

s/2 

+ (—s sin <p cos 0 — f) 2 ] i 


[s 2 -j- t 2 + P 2 + v2 ps cos <p( cos tp 4* s *n ip) 

4- '/2ps sin <p sin 0(sin ip — cos ip) + 2sf sin <p cos 0] ^ 


(A- 7) 


Q4P4 = [(s cos <p cos ip -j- s sin <p sin 0 sin ip 4- p) 2 

s/2 

4- (— s cos <p sin ip 4* s sin </> sin 0 cos ip - p) 2 

s/2 

4- (s sin <p cos 0 — i) 2 ] i 

= [s 2 4- 1 2 4" P 2 4“ v2 ps cos <p(cos ip 4- sin ip) 

4* v / 2/9Ssin0sin0(sinV’ — cosip) — 2st sin<£cos0]^ 


(A.8) 


F Fo 

-4 [—pa sin 0 cos(u; 4" 4) — Z\a cos0 cos ip\-\- — [—pa sin 0 cos(w 4* M 4* z 2. a cos & cos V’] 
L>i L% 

F 1 

4 —-[-pssin<£cos0 — <s(cos <p sin ip — sin <p sin 0 cos ip)] 

L3 s/2 

F 1 

4 - y4[ -pssin^cos# 4 " is(cos<£sin ip — sin<£sin0cos ip)] 

L * s/2 

mgd(sin<p sin ip cob <p sin 0 cos ip) ( 

F Fo 

—- [pa sin 9 sin(u; -f- X) cos 9 sin tp] + 7 - [pa sin 9 sin(u; -j- X) — z^a cos 9 sin tp] 

Li L% 

jp 1 

4 - 44—-pssin^cosfl — ts(cos <p cos ip -J- sin <p sin 0 sin ip)] 

L i s/2 

F 1 

4 - -j4[- p S sin <pcos0 4- ts(cos <p cos ip sin <p sin 6 sin ip)] 

4 , 4 y /2 

mgd[sin (p cos ip — cos <p sin 9 sin ip) (/ 


( £ + § ) ^ cosSsin ’' 

+ f ) —— psfcos <£(sin ip 

v L 3 4>4 / v /2 


cos ip) — sin <p sin 0(cos ip 4- sin ip)] 


(A.9) 


(/UO) 


[A. 11) 
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Note: In equations (A.9MA.11), L 3 and U are as defined in equations (A.7) and (A.8), the others are as 
defined in equations (2.7M2T8). 

A.3 Equations of Motion 

The equations of motion for the two cases of unwrapped tendons can be derived following the proce¬ 
dure in subsection 2.2.4, and instead of using equations (2.36M2.38) for the expressions for T\, T 2 , and 
T 3 , equations (A.4MA.6) or equations (A.9HA.11) are used depending on which pair of tendons are 
unwrapped. The full detail of the equations corresponding to equation (2.48) is given in Appendix B. 


■•*■■■ ■ ■■H 





Appendix B. Equations of motion for the full order model 


By substituting expressions for Ti , T 2 , Tj and equations (2.40)-(2.45) into equations (2.39), the three 
equations become, 


9 • 

0 J cost)} 


Jrn ( dh I dh , „ dh | dl A ' 

-2(C]l^T +C12^ 4-Cl3^ +Ci^ —) 


60 

dh 


dk , &h , _ dl 4 




Xp 


Jm, dll dl 2 dk | <94, 

•79-( c 11K7 + C I2ZI + + c 145t) 


dip 


d\p 


dxp 


l dxp 


K. . , rl , io B >n [ dll a 2 . dl 3 

— \ciih + enh + c 13/3 -f- C14/4J + C15 + 0-^- cn — + ci2^j- + Cl3 ^ Ch ^ 


.•■Bin 


I , -in I dll , dl-2 , dl 3 dl 4 

+ ^[ Cu ^ + Cn 64> + Cl3 64> + CH ^. 

, f B m \ ®i a 2 dh . <9(4 

+ kllTTT +C127T.T + C 13Z7 + C 14£7 


+ 0 2 ^ 


dtp 

A 


<9V» 

<9 2 / 2 


’dxp ' 
^3 


dxp 


d\ 


771 v *1 1 ^ v | ^ w I _ “ 

^ Cl1 ^ + Cl2 ^2 + C 13^ + ‘14^2 


■/ m , a 2 /! , <92/2 , _ A , . < 9 % 


+ 0 2 | (-^ + ^ 3 ) sin 0 cos 0 cos xP + 5(c n ^| + Cl2 iJ + Cl3 ^S + 


<9^- 


<9f 


'6<t> 2 




r',2 ■An 


A A <9 2 ( 3 <92(4 

C l'5^2 + C ‘2^2 + Cl3 ^2 + Cl A5^2 


dip 2 


dtp' 


, oniL l n • • , I J -r, I . , r <9% , r < 92/4 

+ 2# (J- - jJh) ™*«n* + prtc,^ + c.,— + c,3^ + c,4^) 


-J- 2<ptp 


— cos xb cos0 4- — fci I — + c,3_ _L Cn ^3 4 - c . ■— L) 

2 cos V cosff + r 2 + 12 d<A9^ + 12 d<pdip + l4 d<pdip 

m 

, • , , 4, , . <9 2 4 , . A , . <92/4,1 


+ 2# ^4sint/) + ^(cn^^4-Ci 2 




(Rl) 
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Oli , oh , oi 3 C7i 4 

-7 sin P - -^(C 2 i ^ + C 22 ^ + c 23 ^ + c 24 -)j 

..r , j m . at x . di 2 , <% , „ 

+ P JcOS 0 COSp- + C 22 ^ + C 23 d(j) + C 2 ^) 


“|— xp 


J m . dh . dl 2 . <% diu 

—( C 215 ^ + C 22^Z + c 23 ^ + c 24 7^;) 


dip 


dip 


dip 


K *jB m 

=== — [c 2 l/l + c 22^2 + c 23^3 + C 24^4J + c 25 + C 21 

;B m r < 9 /] , (9/2 , <9/3 . ^4" 

+ *7* C21 ^ +C22 ^ +C23 dp + u dp. 


(9/i . < 9/2 , <9/ 3 , < 9/4 

^+C 22 -+ C 23 ^+C 2 4^ 


V* 


r 


+ 0 


\2^rn 


d(p 

dk 
1 dip 

l d6 2 


+ o 22 


dp ' 

dk _ 

l dp 

d% 


dp 

dl 3 


op 1 

dU 


+ C22 ^ + ° 23 ^ + ^dP 


d0 2 


, <9 2 / 3 <9 2 / 4 

+ C 23TS?7 + c 24^ 2 


<90 2 


<5®ij 


d 2 k 


<9+ 


cPL 


+ P 2 1 (i - J 3 ) sin 0 COS 0 sin p + + 022^ + 023^5 + c 24 ^) 


dp 


'dp 


'dp 


! 0 Jr 


<9+ 

dp 2 


d\ 


+ ^^1^+ 022^+023^+024^ 


(9 2 / 3 

'<9i/> 2 


+/ 4 

l (9t/) 2 


..1 J m , <9 2 / 4 . (9 2 / 2 . &h . Q~«4 

+ 26 p (,J - -7 3 )sin0cos^+ ^(c 2 i— +c 22 ^ +c 23 ^ +c 24(9ft ^ 


. h . <9^ , <9% , <9% , „ dl ±\ 

+ 2 PP 2^3 cos 0 sin P + 72 + 21 ^; + C22 ^0 + C23 ^ + C 24 <9#ty j 


dpdp 


dpdp 


d 2 k 

l dpdp 


..[l , J m . d 2 h . d\ , <9% 1 <9 2 / 4 x 

+ 2 po -J 3 cos + C22 dpd0 C ' 23 dxpd0 ^ 24 dxpd0* 


(B.2) 









dl\ , dl 2 Sl 3 dl 4 

C3l do +C32 se +C33 de +C34 M 


+ < p\ —Jjsin# 


7 2- ( C31^+C 32 -+C 33 -+C34^) 


-J- Ip 


J 3 _ ^!i(c 3| ^l _L C32 ^ _|_ C33 ^ 4 - c, —) 

3 r 2 1 3 ‘<9^ + 32 <9tf> + 33 ^ + dip [ 

K. r . . T Tii a B m dl\ 1 < 9 f 2 . dl 3 . < 9 f 4 

— + C32I2 + C33/3 4 " C34-/1J + U-^2 C3i gg 1 C32 g0 ' C33 ^ ' C34 ^0 

a 

1 ;B m L <»i , ^ <3^2 1 - <*3 ; $ 4 " 

+ V[ C31 ^ + C32 ^ + C33 ^ + C3 ^. 

1 / Bm dli 1 dl 2 | dl“3 , <9/4 

+^ r 31 ^; +C32 ^ +C33 ^ +C34 ^ 


+0 


J2 *Xn 


* d\ d\ , &h , <9 2 1 4 
2 C3l ^2 + C32 ^2 + C33 5fl2 + C34 552 


<90 2 


dd 2 


<90 2 


+ # 2 % 

T l 


n <^1 , „ <9% < 92/3 , <9 2 i 4 

2 3 ‘^2 + 32 ^2 + C33 ^2 + 34 ^2 


d(f> 2 ' d<j > 2 


<9?i 2 


, /2^m „ , <9% , „ <92/3 <92l } ’ 

+ ^ 72 C31 ^ + C32 ^2 + 33 ^2 + C34 ^2 

» « 

, oa Jl r „ , J m , &h , ^ , <92/3 , < 92/4 , 

+ 20^2 /3 cose + 7t {C3X d6dj> + C32 dm + C33 dm + C34 ^ } 

+ m J Jc n ^L +cn^-+ 033 ^- + c-^-l 

^ r 2 dtpdip ^ 32 d<pd\p ^ d<fdtp 34 d<pdip 


+ 2#% C3,^+C3 ! ^-+C33^ + C M ^- 

^ ^ r 2 <9^x90 <9^x90 <9^*90 


<92/, 


< 92 ^ 


(5-3) 


In the above three equations, the values of < 4 , L J( lj, i — 1 ,2, 3, j — 1,..4, will depend on the 
values of u> -f- X and u/ 4~ X' as defined by equations (2.7)-(2.8) and (2.19H2.22). 


cn = [—pasin0cos(w + X) — zjacos0cosV’]/£i 
C 12 = [—pa sin 6 cos(w + X) 4* z 2 a cos 0 cos V’l/ia 
C 21 == [pasin0sin(u; + X) -f*^iacos(?sin ip]/Li 
c 22 = [pasin0sin(u) -j- X) — z 2 a cos 0 sin $\jL% 

C31 = pacosflsin X/Lj 
C32 = pacos0sinX/L 2 


Forw + X < 3xr/4, 
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zi , L [, h ,Z 2 , L%, h are as given by equations (2.11) -(2.13) and (2.16H2.18). 
Forw + X > 3 tt/4, 


Cl 1 


Cl2 


C21 


C22 


C31 


C32 


(— pa sin 0 — ai> cos 0 cos t/>]/Li 

V2 

[—!—pa sin0 -f ab cos 0 cos xp]/Li 

v/2 

[_L_p a sin0 + a6cos0sint/)]/Li 

V2 

f —— pa sin 0 — a6cos0sin xp]/Li 

V2 

-1— pa cos 0(cos xp + sin 1 p)/Li 

V2 

— pa cos 0(cos xp -\- sin xp)/L% 

V2 


L u l u La, h are as given by equations (A.l) and (A.2). 
For a/ + X' < 37r/4, 


c 13 = [ps sin <p cos 0 sin(u/ + X') — z 3 s{c os <p sin xp — sin 0 sin <p cos V»)]/^3 
c 14 = [ps sin <P cos0 sin(u/ + X') + z 4 s(cos <psinxp~ sin 0 sin </> cos V>)]/L 4 
c 23 — [—ps sin (p cos0 cos(u/ + X') — z 3 s(cos <pcosxp-\- sin 0 sin <p sin VOl/^3 
c 24 = [ — ps sin <p cos 0 cos(u/ -(- X') -(- z 4 s(cos (p cos xp -f- sin 0 sin <^> sin VOl/^4 
C33 = ps [si n <^> sin 0cos(X / -[-p ; ) cosi^sin(X -)-p)]/L3 

c 34 = ps[sin <p sin 0 cos(X / -|- pQ cos <p sin(X -{- p )]/L 4 


2 3i £, 3> ; 3i 2 4> L 4 , ( 4 are as defined in equations (2.25)—(2.27) and (2.30)-(2.32). 
Foru/ + X' > 37r/4, 
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Cj3 = [—— ps sin 0cos0— si(cos <p sin ip — sin0sin<£cos ip)][L,3 
\/2 

Ci4 = [—ps sin <pcos0 + sf(cos <p sin ip — sin 0 sin 0 cos ip)]/L4 

y/2 

C23 — [—ps sin$cos0 — st(cos <p cos ip + sin0sin<^>sin ip)\/Lj 

V2 

c 24 — [—ps sin <pcos0 -f- s<(cos <p cos ip + sin 0 sin <£ sin </>)]/L4 

V2 

C33 = -ps [cos <p(sin ip — cos ip) — sin <p sin 0(cos ip -f- sin ip)]/L 3 

s/2 

C34 =-ps[cos^(sin^> — cosip) — sin0sin0(cos^> + sin ip)]/L4 

s/2 

L3, l 3 , L 4 , l 4 are as defined in equations (A.7) and (A.8). 


For all cases. 


Cj 5 — mgd( sin <p sin ip + cos <p sin 0 cos ip) 
C 25 — mgd( sin <p cos ip — cos <p sin 0 sin ip) 


Equations (B.1)-{B.3) are of the form. 


hiiO -f- hi2<j> -J- htfip — gi(0, <p, ip, 6, <p, ip) -|- qijij i = 1 , 2 ,3 


j—i 


where the hi/ s, and q t /s are functions of 6, <p, ip. 


(BA) 


Written in component form, 

» 

hu hi 2 
/121 /122 /123 

^31 h 32 ^33 


hi3 

0 


01 (0,^» ip, 8,4,4) 


011 0X2 013 014 

hi3 

• • 

— 

9i{8, <P, <P, 0, <A, tA) 

+ 

021 022 023 024 

^33 

«■# 

• * 

A 


. 03 ( 0 , 4, 4, 0 . <A, ^A). 


031 032 033 034 


h 

h 

h 

.41 


IB. 5) 


m 


Define 


H 


/lH ^*-12 hl3 
/l21 /»22 ^23 

/l31 h'32 /l33 












Appendices C-E have been excluded from die Memo version of this thesis. 



Appendix F. 




Using voltage instead of current inputs 


The electrical equation of motor i is given by. 


L a —7 + Rli + f^Eli 


(F.l) 


where L a , R , Ke are the m °t or s 
angular speed of the motor. 


inductance, resistance and EMF constant respectively, and 7 ; is the 


For the pancake type of motor that we are using, 


L a ^ 0 


and since in S.I. units, the EMF constant and the torque constant are equal, we will use the symbol K for 


both of them. 


Hence equation (F.l) can be written as 


Rh + Rii 


K . 
R * 


(F.2) 


From equation (2.42), the dynamic equation of motor i is given by, 

Jmli + Bmli + Fi r = Kli 


(F.3) 


Substituting equation (F.2) into (F.3), we obtain. 


IS 2 

Jmlt 4 - (Rm + ~x)ii 4 - Fi 


K v 

r= R V 


(FA) 


which is of the same structure as equation (F.3) except that (B m 4- F 2 /R) is substituted for B m and K/R 
is substituted forF. 

Hence all the equations and programs that have been developed for current inputs can be applied to 
the case of voltage inputs by changing the values of the damping constant B m and torque constant K of 


the motor. 



Appendix G. Values of the parameters used in the simulation runs 


G.l 

Arm Parameters 



a 

0.4064 m 

refer to figure 2-6 

/ " 

b 

0.4064 m 

refer to figure 2-6 


d 

0.117 m 

refer to figure 2-6 


s 

0.2032 m 

refer to figure 2-6 


t 

0.2032 m 

refer to figure 2-6 


P 

0.02223 m 

radius of the cylindrical rod 


m 

1.581 kg 

mass of arm 


J 

0.0906 kg m 2 

momemt of inertia of am about X — 

X and Y — Y axes 

h 

0.000407 kg m 2 

moment of inertia of arm about Z — 

Z axis 

G.l 

Motor Parameters (PMI motor type U12M4) 


r 

0.016 m 

radius of motor shaft 


K 

0.11 N m/A 

torque constant 


Jm 

0.00016 kg m 2 

moment of inertia of motor shaft 

Bm 

0.000135 Nm, 

Irad 8~ 1 damping constant 



The rated current of the motor is 4.4 A. 






